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SUMMARY  &  CONCLUSION 

Tracking  3D-targets  with  a  2D-radar  is  a  significant  and 
challenging  problem.  Motivated  by  the  Range-Parameterized 
EKF  (RPEKF)  algorithm  used  in  the  problem  of  bearing-only 
tracking,  we  present  a  practical  solution  to  solve  this  problem 
in  this  article,  i.e.,  Height-Parameterized  EKF  (HPEKF). 
This  method  could  reduce  the  fuzzy  phenomenon  in  height 
information  of  the  target.  So  we  can  track  3D-targets  with  a 
single  2D-radar  in  an  effective  way  under  some  conditions. 

1.  INTRODUCTION 

It  is  well  known  that  we  can  only  get  target  bearing  and 
target  range  from  a  2D-radar.  To  eliminate  the  fuzzy 
phenomenon  when  using  2D-radar  to  track  3D-  targets,  the 
geometric  method  is  generally  adopted.  However,  it  is 
indicated  theoretically  and  experimentally  that  this  method  has 
poor  performance  especially  when  the  range  is  far  or  the 
altitude  is  low  [1-4].  Then,  Tracking  3D-targets  using  such 
insufficient  information  is  a  significant  and  challenging 
problem. 

Although  there  exist  some  similarities,  the  problem  of 
tracking  a  3D-target  with  a  2D-radar  has  apparent  difference 
from  the  problem  of  bearing-only  tracking.  In  both  of  the 
tracking  problems,  the  information  gained  by  the  observation 
platform  is  incomplete.  However,  because  we  can  get  target 


range  from  a  2D-radar,  the  target  in  the  former  situation  is 
observable  if  the  height  of  the  target  is  invariable.  But  the 
performance  of  tracking  is  highly  dependent  on  the  accuracy 
of  initial  height,  and  in  general,  the  height  is  not  known 
beforehand.  To  solve  this  problem,  we  present  a  practical 
algorithm  in  this  article,  i.e.,  Height-Parameterized  EKF 
(HPEKF).  This  method  is  activated  by  the 
Range-Parameterized  EKF  (RPEKF)  [5,  6]  used  in  the 
bearing-only  tracking  problem.  Our  main  ideas  is  that,  to 
reduce  the  fuzzy  phenomenon  in  the  height  information,  we 
divide  the  height  interval  of  interest  into  a  number  of 
subintervals,  and  each  subinterval  is  dealt  with  an  independent 
EKF.  The  weights  associated  with  each  EKF  are  computed  to 
determine  how  the  state  estimate  of  each  filter  is  combined. 
And  the  updated  state  estimate  and  covariance  matrix  of  the 
height-parameterized  tracker  can  be  computed  as  a  weighted 
sum  of  the  individual  estimates  and  covariance  matrices. 

2.  PROBLEM  STATEMENT 

Let  us  consider  a  3D-target,  located  at  coordinates 
(x(f),  y(t),  z{t))  moves  with  a  nearly  constant  velocity  vector 
(i(f) ,  y(/) ,  z(t))  and  nearly  constant  height.  Then  the  target 
is  defined  to  have  the  state  vector 

/ 

x(t)=  [x(t),  v(f),  z(t\ x(t),  y(t\ z{t)]  , 

where  the  prime  denotes  transpose,  and  the  discrete  time  state 
equation  for  this  problem  can  be  written  as 
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The  HPEKF  tracks  the  state  of  a  3D-target  with  a  number 
of  independent  EKF  trackers,  each  with  a  different  initial 
height  estimate  .  To  do  so,  the  height  interval  of  interest  is 
divided  into  a  number  of  subintervals,  and  each  subinterval  is 
dealt  with  an  independent  EKF.  Suppose  the  height  interval 
of  interest  is  (zmin ,  zmax ) ,  and  we  wish  to  track  using  NF 
EKF  filters.  For  a  particular  EKF,  we  note  that  the  tracking 
performance  is  highly  dependent  on  the  Coefficient  of 
Variation  the  height  estimate  [5],  Cz ,  given  by  o z/z ,  where 
z  and  <Jz  are  the  height  estimate  and  its  standard  deviation 
respectively.  In  order  to  maintain  a  comparable  performance 
for  all  NF  filters,  it  is  desirable  to  subdivide  the  interval 
(z  •  ,  zmaT )  such  that  C  is  the  same  for  each  subinterval. 
Note  that  Cz  for  each  subinterval  may  be  computed 

approximately  as  a z  /  z{  ,  where  z{  is  the  mean  of  subinterval 


T  is  the  sampling  time,  wk  is  an  i.i.d  process  noise  vector  /  and  a  [ s  the  height  standard  deviation  for  that  subinterval, 
with  w*  -  N(0,  Q0)  .  Where  Q0  -  <JaI3 ,  <7a  is  a  scalar,  Assuming  the  height  errors  to  be  uniformlv  distributed  in  each 


/3  is  the  3  x  3  identity  matrix. 

The  available  measurement  at  time  k  encompasses  the 
target  bearing  0(k)  and  target  range  r(k )  .  It  can  be 
modeled  as 

zk  =tf(x*)+v*  =ik  +  vr>  (2) 

where  v*  is  an  independent  Gaussian  measurement  noise 

vector  with  ~  ^V(0,  R0) ,  Here  R0  =  diag((J2r,  aj),  whereas 

zk  is  the  noise-free  bearing  and  range  vector 


zk  =Hi*k)= 


/x2(ft)+;y2(ft)+z2(fc) 


Assuming  the  height  errors  to  be  uniformly  distributed  in  each 
subinterval,  the  desirable  subdivision  can  be  obtained  if  the 
subinterval  boundaries  are  chosen  as  a  geometrical  progression. 
If  p  is  the  common  ratio,  we  have  the  relation 


"^max  ^min  P 


which  gives  p  as 


For  the  above  division  of  range,  it  is  easily  established  [5]  that 
the  coefficient  of  variation  is  given  by 

1L.  (4) 

2;  V12  (/£>  +  !) 


Given  a  sequence  of  measurements  zk,  k  =  1,2, ••  •  ,  To  determine  how  the  state  estimate  of  each  filter  is 

defined  by  (2)  and  (3),  and  target  motion  model  described  in  combined,  we  need  to  compute  the  weights  associated  with 
(1),  the  tracking  problem  is  to  obtain  estimate  of  the  state  each  EKF.  At  time  step  1,  let  the  probability  that  the  true 
vector  xk . 

track  originated  from  the  i- th  subinterval  be  denoted  by  w\ . 


3.  HEIGHT-PARAMETERIZED  EKE 


These  probabilities  of  the  distribution  of  target  height,  which 
form  the  initial  weights  for  the  HP  tracker,  is  supposed  known, 
e.g.,  Gaussian  distribution.  If  no  prior  information  about  the 
true  height  is  available,  we  get  the  probabilities  from  a 
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uniform  distribution.  The  corresponding  probabilities  at  time 
k  can  be  computed  recursively  according  to  Bayes’  rule, 


i= 1 


p(z*  i « Vi-! 

1  j)wi- 1 


(5) 


where  p(zk  I  z)  is  the  likelihood  of  measurement  zk ,  given 
that  the  target  originated  in  subinterval  i.  Assuming  Gaussian 
statistics,  this  can  be  computed  as 


p{zk\i)  = 


where  zlm_x  -  )  is  the  predicted  measurement  at 

k  for  filter  i ,  and  Rj  is  the  innovation  variance  for  filter  i 
given  by 


The  tracker  initialization  for  HPEKF  is  carried  out 
according  to  standard  initialization  techniques  for  single  EKF 
trackers.  In  particular,  the  state  vector  and  its  covariance  are 
initialized  as  [8] 

Xoio  =  if I2  -  z; 1  sin  A  —  z~  cos #, ,  z„  0,  0,  o) , 

P0'0  =  diag (cr2 ,  a\ ,  a\ ,  a 2 ,  a2v ,  a2), 

where  z1  =  (r19  Gx)  is  the  initial  2D-radar  report,  zt  and  o z 

are  mean  and  standard  deviation  of  height  estimate  for  interval 
i  assuming  uniform  distribution  of  errors,  and  <Jv  is  the 
velocity  standard  deviation. 


where 


^=HlkP^Hlk  +R0, 


(7) 


Hi  =  dH  (x) 


dx 

x 


x2  +  y2 


Vx2  +  y2+z2 


x2  +y2 


0  0  0 
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The  HP  tracker  has  to  implement  NF  EKFs  if  all  the 
height  subintervals  are  processed  throughout.  However,  it 
has  been  found  that  in  a  majority  of  target-observer  scenarios, 
the  weighting  of  some  of  the  subintervals  rapidly  reduce  to 
zero.  In  such  cases,  the  corresponding  filters  can  be  removed 
from  the  tracking  process  without  loss  of  accuracy,  thereby 
reducing  the  processing  requirement.  Thus,  a  weighting 
threshold  can  be  set  and  any  filter  corresponding  to  a 
subinterval  with  a  weight  less  than  the  threshold  may  be 
removed  from  the  tracking  process. 


is  the  linearised  measurement  matrix  ,  and  Pklk_}  is  the 


predicted  covariance  for  filter  i ,  and  R0  is  the  measurement 
variance  matrix. 


4.  ALGORITHM  FOR  HPEKF 


Now,  suppose  that  the  updated  state  estimate  of  filter  i 

is  denoted  by  .  Then,  the  updated  state  estimate  of  the 

height-parameterized  tracker  can  be  computed  as  a  weighted 
sum  of  the  individual  estimates, 

nf 

Kk=Yjw‘Ak-  (8) 

i-\ 

Similarly,  if  Pk]k  denotes  the  covariance  matrix  of  the  i- th  filter 

at  k ,  the  corresponding  covariance  for  the 

height-parameterized  tracker  may  be  computed  as 


Based  on  the  elements  presented  above,  it  is  possible  to 
propose  the  following  generic  algorithm  for  HPEKF. 

Algorithm  for  HPEKF 

1.  Divide  the  height  interval  into  N F  subintervals. 

2.  Initialization:  at  k-  1 ,  for  i  =  1,  2,  •  •  •,  NF  ,  set 

K\0  =  iff  -z,2  sin #1  •  fF-z2  cos#!,  z,,  0,  0,  o) , 

P0'0  =  diag (cr2 ,  <72 ,  a\ ,  o2v ,  a2v ,  a2). 

3.  At  time  k  ,  for  i  =  1,  2,  •  •  • ,  NF 
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Implement  EKFs  parallel: 

^414-1  =  ^*414-1  ^414  *^414-1  ’ 

U  /  \-l 


+7?0J  ; 

*414  =  *414-1  +  ^"4  (Z4  _  Z  414-1  )  ’ 

^4  =(/-^//;h',*_1. 

Compute  the  weights  associated  with  each  EKF: 


w,  =- 


p(z4 1  »ViLi 

ZlXz4 1  iV/-i 


filter  equations.  The  results  are  an  average  of  Monte  Carlo 
simulations  with  100  trials. 

Figure  1  shows  the  RMSEs  in  the  height  estimates  for  the 
EKF  with  5000m  initial  height.  Figure  2  and  figure  3  show 
the  RMSEs  in  the  height  estimates  for  EKF  with  4000m  and 
7000m  initial  height  respectively.  It  can  be  find  that  the 
height  estimates  sequence  is  convergent  and  the  estimate 
errors  are  small  if  the  initial  height  is  relative  accurate.  If  the 
initial  height  is  not  accurate,  the  height  estimates  sequence  is 
divergent.  Figure  4  shows  the  comparison  of  the  RMSEs  in 
the  height  estimates  for  the  EKFs  with  initial  velocities  along 
with  the  v  axis  300  mis,  400  mis  and  500  ml  s  respectively. 
Note  that  the  influence  of  the  velocity  initialization  is  very 
small.  Figure  5  shows  the  RMSEs  in  the  height  estimates  for 
the  HPEKF.  From  this  figure  we  can  see  that  the  height 
estimates  sequence  is  convergent,  and  the  height  estimate 
errors  are  close  to  the  height  estimate  errors  for  the  EKF  with 
real  height  of  the  target  as  its  initial  height. 


where 


p{zk  I  i) 


•  Compute  the  state  estimate  and  the  corresponding 
covariance  of  the  target: 


i=i 


Fig.  1  RMS  height  error  with  5000m  initial  height 


5 .  SIMULATION  RESULTS 

The  example  considers  a  target  that  starts  at 
v  =  1000  m,  y  =  50000  m  and  z  =  5000  m  and  travels  along 
with  the  v  axis  at  a  speed  of  300m  /  s  .  For  this  illustrative 
example,  a  rotating  radar  with  a  scan  period  of  Is  provides 
range  and  bearing  measurement.  The  radar  provides  range 
measurements  with  a  standard  deviation  of  150m  and  bearing 
measurement  with  a  standard  deviation  of  0.7°.  The  range 
and  bearing  measurements  are  processed  via  extended  Kalman 


Fig.  2  RMS  height  error  with  4000m  initial  height 
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Fig.  3  RMS  height  error  with  7000m  initial  height 


Fig.  4  RMS  height  error  comparison  with  different  velocity 
initializations 
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